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SUMMARY 

A  Kalman  filter  and  smoother  which  uses  data  from  position 
measuring  instrumentation  to  estimate  changes  in  position, 
velocity,  and  acceleration  is  derived  in  detailed  analytic 
form.  The  filtering  and  smoothing  characteristics  are  shown 
to  be  completely  determined  by  a  single  non-dimensional  para¬ 
meter,  which  itself  is  a  simple  function  of  the  input  para¬ 
meters  to  the  filter.  The  concept  of  the  bandwidth  of  the 
filter  and  the  smoother  is  examined,  and  analytic  expressions 
are  derived  for  the  bandwidth  of  the  smoother,  and  of  the 
filter  with  respect  to  position.  The  analysis  highlights 
situations  in  which  the  smoother  is  clearly  superior  to  the 
filter. 
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1 .  INTRODUCTION 

There  are  many  situations  in  which  the  Kalman  filter  and  smoother  are  applied, 
where  some  of  the  assumed  input  parameters  (usually  the  plant  noise  are  measure¬ 
ment  noise  matrices,  Q  and  R)  are  unknown.  The  response  to  this  problem  in  some 
cases  has  been  to  modify  the  filter  to  generate  estimates  of  Q  and  R  as  part  of 
the  filter,  or  to  modify  the  filter  gain  to  allow  for  the  fact  that  Q  and  R  are 
unknown (ref . 1) .  A  summary  of  these  various  approaches  has  been  given  by  Mehra 
(ref. 2).  It  is  noted  that  the  incorporation  of  the  estimation  of  Q,  and  R 
within  the  filtering  process  is  feasible  only  when  there  is  enough  incoming 
information  from  the  data  collection  system.  That  is,  either  Q  and  R  must  be 
varying  slowly  enough  for  them  to  be  determined  within  a  time  scale  less  than 
that  of  their  rate  of  change,  or  else  the  state  vector,  x^,  must  be  overdetermined 

by  the  measurements  yk  at  each  data  time  t^. 

In  applications  of  the  Kalman  filter  and  smoother  as  a  general  purpose  tool  on 
a  testing  range(ref .3) ,  Q  is  normally  unknown,  and  in  many  cases  may  be  required 
to  vary  rapidly  over  short  periods  of  time.  This  particularly  occurs  when  the 
smoother  is  used  to  process  data  from  cameras  monitoring  incidents  such  as  inter¬ 
ception,  and  sharp  changes  in  acceleration.  The  application  of  the  Kalman 
filtering  and  smoothing  algorithms  in  such  cases  is  then  of  necessity  sub-optimum, 
and  the  practice  has  been  to  use  the  specification  of  Q  as  a  tool  to  control  the 
bandwidth  of  the  filter  and  smoother.  In  fact  this  approach  has  been  so  success¬ 
ful  in  practice  that  it  has  been  found  unnecessary  to  include  deterministic 
changes  in  acceleration  components  when  monitoring,  say,  sharp  changes  in  accel¬ 
eration.  This  is  despite  the  fact  that  Q  does  not  then  represent  a  white  noise 
process,  as  required  by  the  filter  model.  (This  use  of  Q  is  similar  to  that 
made  sometimes  in  overcoming  filter  divergence  (see  Jazwinski (ref .4)  p305)). 

The  altered  use  of  the  plant  noise  matrix,  Q,  requires  a  different  interpret¬ 
ation  of  the  Kalman  filter  and  smoother,  and  it  is  the  purpose  of  this  paper  to 
show  how,  for  the  particular  general  purpose  smoother  of  reference  3,  to  derive 
analytic  expressions  for  the  filtering  gains  and  the  smoothing  frequency  bandwidth 
as  a  function  of  Q. 

As  a  by-product  of  this  derivation,  functional  relationships  which  further 
elucidate  the  differences  between  the  Kalman  filter  and  the  smoother  appear. 

In  particular,  the  clear  superiority  of  the  smoother  over  the  filter  becomes 
apparent  when  position  measuring  devices  are  used  to  estimate  acceleration  changes. 
This  reinforces  in  a  different  and  more  specific  way  the  existing  general  recog¬ 
nition  of  the  comparative  performance  of  the  filter  and  the  smoother(ref .5,6) . 


2.  PROBLEM  PRESENTATION  AND  ASSUMPTIONS 

The  model  which  will  be  utilised  is  basically  that  of  the  general  purpose 

Kalman  smoother (ref . 3) ,  except  that  the  analysis  will  be  restricted  to  one- 

dimension.  This  restriction  should  not  unduly  limit  the  applicability  of  the 

results  that  are  obtained,  since  it  is  usually  possible  to  find  an  axis  system 

in  which  the  filter  operates  essentially  independently  in  each  axis.  (That  is, 

axes  are  aligned  with  the  eigenvectors  of  the  measurement  noise  matrix,  R) . 

Thus  the  state  vector,  x  ,  at  time  t  ,  will  be  a  3-component  vector  of  missile 

K  K 

position,  velocity,  and  acceleration.  The  equations  of  state  are  then  - 


xR  =  $(k,k-l)xk_1  +  <^k. 


where  E(o^u^  )  Qk»  E(o^_)  -  0, 


and  is  the  plant  noise. 
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Here  li’(k,k  1)  is  the  transition  matrix  defined  according  to  a  constant  acceler¬ 
ation  model.  Thus,  for  h  =  (t,-t  ), 

k  k  —  1 


<h(k,k-l) 


1,  h,  h2/2 

0,  1,  h 

0,  0,  1 


The  equations  describing  the  measurement  system  are 


HkSxk  * 


(2) 


E(^k  "k  )  -  Rk>  =  0  k  is  the  measurement  noise), 


We  also  assume  that  the  measurement  system  directly  (rather  than  indirectly) 

measures  position,  so  that,  if  there  are  m  measurements  at  time  t,  ,  H,  is  an  mx3 

K  K 

matrix  which  is  zero  except  for  the  first  column  which  is  all  ones. 

The  filtering  algorithms  are  then 


and 


k/k-1 

=  <h(k,k-l) 

xk-i/k-r 

k/k-1 

=  fh(k,k-l) 

Pk-l/k-l  +  Qk, 

k 

=  H^  R."1  H. 
k  k  1 

c* 

k 

=  Hk 

k/k 

II 

*- 

i—4 

f — \ 

hH 

+  Fk  Pk/k-l-)  1  » 

k/k 

_  Xk/k-l  + 

- ■n 

•k-o 

m 

a, 

Here  5y^_  is  the  vector  of  differences  between  the  data  and  the  data  implied  by 

Xk/k-l‘  In  Parti-cular>  ^yk  =  ^k^xk_xk/k-l-*  +  ^k  sance  we  are  assuming  direct 
measurement.  is  the  information  matrix,  and  will  always  be  zero  except 

(rk)u  =  7,  say.  In  interpreting  r  and  it  should  be  noted  that  if  there  is 

a  single  measurement  of  position,  with  standard  deviation  a  at  each  data  time 

t^,  then  Crk) i i  =  l/o2,  and  (?k)i  =  (yk  - Cxk/k_i)i )/o2 .  We  may  use  this  know¬ 
ledge  of  the  form  of  to  replace  the  fourth  and  sixth  equations  of  the  system 

of  equations  (3) ,  by  the  single  equation 


xk/k  =  A  xk-i/k-i  *  pr  xk  w 

and  we  have  found  it  convenient  to  define  A  =  (I  -  pr)<h.  (5) 

In  defining  Q^,  there  are  two  equally  reasonable  approaches. 

If,  as  is  usually  the  case,  equation  (1)  is  a  discrete  approximation  to  a 
continuously  evolving  system,  then  we  may  model  the  noise,  Q^,  by  assuming  it 

to  arise  from  a  continuous  white  noise  in  the  acceleration  component.  Thus 
dQ/dt  =  (),  say,  and  the  discrete  may  be  found  by  integrating  the  continuum 

equivalent  of  equation  (3)  from  t,  .  to  t,  .  (The  form  of  the  integral  becomes 
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obvious  if  it  is  envisaged  that  there  are  a  large  number  of  "dummy"  data  points 
inserted  between  and  t^  for  which  there  is  no  incoming  data.  i.e. 

T  =  f  =0.  Equation  (3)  is  then  recursively  applied  through  these  points). 
Thus  we  have 


Qk 


r)dQ/dr  (I)T (t^  -  r)  dr 


1/20  h5  , 
1/8  h4, 

1/6  h3. 


1/8  h4  ,  1/6  h3 

1/3  h3,  1/2  h2 

1/2  h2,  h 


It  is  slightly  less  accurate  to  assume  that  noise  is  added  to  the  acceleration 
component  in  "lumps"  of  hq  =  q  at  each  data  time.  Then 


Qi 


0, 

0, 

Lo, 


o, 

o, 

o. 


o 

o 

l 


(6) 


The  two  definitions  might  be  expected  to  give  divergent  results  only  when  data 
is  arriving  at  sufficiently  irregular  time  intervals,  (in  which  case  the 
definition  (6)  would  be  less  reasonable) . 

In  the  present  analysis,  however,  we  are  looking  for  steady  state  relation¬ 
ships  linking  with  other  filtering  parameters,  and  it  is  therefore  reasonable 

to  assume  a  constant  data  rate  (h  =  t^-t^  y  all  k) ,  and  to  use  the  much  simpler 

definition  (6).  This  definition  will  in  any  case  give  answers  accurate  to  o(h). 

The  final  equation  needed  to  complete  the  filtering  system  arises  from  the 
assumption  of  a  steady  state  in  the  filtering  process.  Then 

Pk/k  =  Pk-l/k-l  =  P’  say’ 

and  we  set 

p  =  P  =  p' 

K+l/k  x/k-1  • 


The  smoothing  system  is  defined  by 

Xk/N  =  xk/k  +  Ck(xk+1/N  "  xk+l/k')  ’  ^8) 

where 

Ck  ■  pk/k  #(ktl-k)pkh/k  -  p$Tp‘-1  -  C. 

The  equation  for  P*  in  equation  (3)  and  equation  (5)  can  be  used  to  alternat¬ 
ively  express  C  as 


C 


PAT  P  1 


(9) 
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3.  BASIC  FUNCTIONS  AND  DEFINITIONS 


3.1  Impulse  response  sequence 

The  impulse  response  sequence,  H  (n) ,  of  a  digital  filter  is  defined  such 
that 


f(n)  = 


H  (k)  g(n-k). 


k=-oo 


where  g(n)  is  the  signal  sequence,  and  f(n)  the  filtered  signal (ref . 7) 
For  the  filter,  as  defined  by  equation  (4)  we  may  show  that 


k/k 


AN  P  r  X. 


k-N* 


N=0 


and  hence  the  filter  impulse  response  sequence  is 


H  F(n) 


(0  ,  n  <  0, 

(An  pr,  n  >  0. 


(10) 


To  derive  the  impulse  response  sequence  for  the  smoother  we  take  the  basic 
recursive  relation  of  equation  (8)  and  reformulate  it  by  repeated  substitution 

of  xk+l/-°>  xk+2/°°  t0  give 


and  hence 


k/c 


chi -of)  *k+./k+r 


j=0 


k/c 


=  P 


^  (at)jt  ^  ALpr  x. 


k+J-L’ 


J=0 


L=0 


where  we  have  set  T  =  P  1  (I-C$) . 

By  substituting  N  =  J-L,  and  then  breaking  up  the  summation  over  N  into  2 
-1  J 


parts 


we  have 


*k/~  =  p  2,  (aT)Jt 

J=0 


N=1 


aJ+n  prxk-N  +  2,  aJ_n  prx^+N 

N=0 
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ET  J  J 

(A  )  T  A  ,  and  reverse  the  order  of  the  second  summation. 


J=0 

we  may  show  by  manipulation  that 


k/° 


—  =  pI  >  ANprxv.M  +  p  \  '  (ATjNTPrxk+N. 


k-N 

N=1  N=0 


Thus,  the  smoother  impulse  response  sequence  is  defined  as 

p  t  an  pr  ,  N  >  0, 

P(AT)-N  t  pr  ,  n  <  o, 

and  by  manipulation  of  the  definition  of  we  may  show  that  satisfies 

T 

T  =  T  +  A  T  A 


Hs(N)  = 


(11) 


Instead  of  solving  this  equation  for  T,  it  is  slightly  more  convenient  to 
use  an  associated  matrix  S,  defined  as 


S 


Y  (AT)Jr«J>AJ. 
J=0 


S  satisfies 


s  =  r$  +  atsa. 

We  may  show  that 

TA  =  P-1  A  -  ATP-1$A  =  P_14>  -  ATP_1$A  -  P&, 


(12) 


and  hence  that 


T  =  (P  1  ^-S)A_1  . 


(13) 


3.2  Filter  system  gains 

If  at  a  time  t^  there  is  a  step  in  (x^)i  (position)  of  D,  then  the  filter 

will  respond  with  a  correction  of  Daj  to  the  predicted  position  coordinate. 
&i  is  called  the  filter  gain  with  respect  to  position.  Its  inverse  is  the 
approximate  number  of  data  points  required  before  the  filtered  state  vector 
Xk/k  w^-*-  full/  respond  to  the  step  change  D  in  position. 

By  considering  step  changes  in  velocity  and  acceleration  in  the  input 
signal  we  may  arrive  at  similar  definitions  of  a2  and  a3 ,  the  velocity  and 
acceleration  filter  gains  respectively.  These  definitions  are  in  fact 
equivalent  to  the  definitions  of  the  gains  a,  j3  and  7  of  the  a-(3-y  filter. 
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Although  aj  represents  the  (non-dimensional)  bandwidth  of  the  filter  with 
respect  to  position,  equivalent  statements  cannot  be  made  of  a2  and  0.3  ,  for 
reasons  which  will  become  more  apparent  in  Section  5. 

For  a  step  change  D  in  position  at  t,,  we  have 

K. 

=  (7D,0,0), 

and  hence  from  equations  (3), 

=  (PTk),  =  P,i  7  D. 


(Here  we  have  used  the  notation 

p  -  (Py);  iJ  =  1,2,3). 


Hence 


=  7  P11.  (14) 

In  the  same  way  a  step  change  of  D  in  velocity  will  lead  at  the  next  data 
time  to  an  error  in  predicted  position  of  hD.  Then  =  (7hD,0,0),  and  the 
initial  correction  to  velocity  is  an  amount 

Da2  =  (P?)2  =  Pi27hD. 


Hence 


0-2  =  7hPi  2  • 

Similarly  we  can  show  that 


(15) 


a3  =  1/2  7  h2  P13  . 


(16) 


4.  ANALYTIC  SOLUTIONS 


4.1  Filter 

Letting  P*  =  (Pi /) ,  and  d  =  (1  +  7P1 1 )  1  , 
equation  (3)  may  be  expanded  to  give 


the  equation  for  P 


k/k 


in 


P 


Pll', 

Pi  2 

9 

Pi  3 

d 

P 12, 

P2  2  /d 

-  7P'i2  , 

P2  3  /d 

-  7  Pi  2  Pi  3 

Pi  3, 

p'23/d 

-  7P'i2  Pi  3  , 

Pis/d 

-  7  Pi  3 

The  equation  for  P^k  ^  in  equation  (3)  may  be  similarly  expanded  to  give 
P'  in  terms  of  the  P„ .  The  steady  state  condition  (7)  may  then  be  applied 
to  eliminate  the  Pi /,  and  give  6  equations  (note  P  and  P*  are  symmetric)  in 
the  7  parameters  Pi  1  ,  Pi2,  Pi 3,  P22,  P23,  P33  and  q.  Thus,  as  expected. 


7 


ERL-0087-TR 


specification  of  q  determines  P,  and  in  particular  the  filtering  gains  which 
are  related  to  Pi  i  ,  P12  and  Pi  3  . 

The  equations  (after  some  manipulation)  are 


dq 
dhP3  3 
(l-d)Pi3 
1/2  7 Pi  2 
(1-d) P i 2 

and  0 


=  7Pi  3  , 

=  7Pi  3  Pi  2  , 

=  d(hP23  +  1/2  h2  P33), 

=  d(hP23  +  1/2  h2  P3  3  )  * 

=  d(hP22  +  hPj3  +  3/2  h2P23  +  1/2  h3  P3  3  ) , 

=  (2hPi2  +  h2Pi3  +  h2P22  +  h3P23  +  1/4  h4P33)-  ^ 


(17) 


Here  we  have  chosen  to  carry  d  separately,  since  we  may  use  equation  (14) 
directly  to  show  that  d  =  1-u.j  . 

By  substituting  from  equations  (14)  to  (16)  we  may  solve  the  equations  (17) 
to  give  the  functional  relationships 


and 


4ai  a3  =  a?  , 


a2  -  4(2-Oj)a2  +  4a2 


0. 


(18) 


If  we  define  g  =  2-ax  +  2(l-ax),  we  may  show  by  manipulation  that 
“2  =  2a?  /g,  and  a3  =  a?/g2  . 


(19) 


Note  in  particular  that  the  relationships  (18)  and  (19)  are  dependent  only 
on  the  structure  of  the  filtering  system  (the  constant  acceleration  model  for 
missile  dynamics,  the  plant  noise  model,  and  the  position  measuring  instrum¬ 
entation),  and  not  on  the  parameters  of  that  system. 

An  alternative  form  of  equation  (19)  which  may  be  useful  is  found  by 
setting  r2  =  (l-ax).  Then 


ai  =  1-r2 ,  a2  =  2(l-r)2,  and  a3  =  (2-r)3 / (1+r) .  (20) 


The  equation  for  the  noise  increment,  q,  may  be  found  by  substituting  for 
Pi 3  in  equation  (17): 


q  =  4o2/(d7h4). 

This  equation  may  alternatively  be  reconstructed  so  as  to  define  a  non- 
dimensional  parameter  of  the  filtering  system, 

e2  =  o3  /  (l-ai  )  =  7 qh4  / 4 ,  (21) 

and  e  will  then  determine  all  other  variables  in  the  system. 

In  terms  of  r,  equation  (21)  becomes 

e  =  (1-r)3/ (r(l+r)) . 

The  remaining  terms  in  P  may  also  be  found  from  equation  (17) : 

P22  =  a?  (12-10ai_a2)/(8h27Oi  (l-ai)), 

P23  =  o3  (2ax  -a2  )/  (h3  7(l-ai)),  and 

P33  =  2o2  a3 /  (h4  7 (l~ai ) )  • 
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4.2  Smoother 

Having  obtained  P,  4?  and  T  in  analytic  form,  it  is  obviously  a  straight¬ 
forward  step,  though  perhaps  tedious,  to  substitute  in  the  equation  (5)  and 
(9)  to  find  the  smoothing  matrix,  C,  in  analytic  form.  However,  rather  than 
follow  this  path,  we  choose  to  seek  an  analytic  form  of  S,  which  plays  a  key 
role  in  the  impulse  response  form  of  the  smoother  (equation  (11)),  and  which 
will  also  be  important  in  determining  the  step  function  response  in  Section  5. 

We  may  immediately  note  from  the  definitions  of  A  and  S,  and  our  knowledge 
that  P  01  1/t,  that  A  is  independent  of  7,  and  S  a  7. 

To  examine  the  dependence  of  these  functions  on  h  =  (t^  -  t^_^)  we  note 

that 


and 


<£.  .  a  h-*  1, 

13 


P..  oc 

13 


It  follows  from  the  definition  of  A  that 


a  h 


3-1 


and  hence  we  can  show  that  equation  (12)  is  satisfied  if 


S..  «  h1^'2. 

13 


The  same  technique  may  also  be  applied  to  equation  (11)  to  show  that 


(H  s (N) ) i j  «  hJ_1,  all  N. 


Having  determined  the  dependence  of  all  smoothing  matrices  on  7  and  h,  we 
may  without  loss  of  generality  assume  7  =  h  =  1  in  subsequent  calculations. 
By  direct  calculation  we  may  show 


A  = 


and 


where 


1-1  - 


0i 

02 

03 

04 


1-ai 

,  l-o-i 

,  1, 

-a2 

,  l-o2 

,  1 

-2a3 

,  -2a3 

y 

0i, 

-1, 

= 

02, 

1, 

203  , 

0, 

(1-0-2  +0-3)70 

= 

(a2  -2a3 

)  704 

= 

O-3  /04  , 

= 

(l-al). 

l-a3 


1/2 

-1 

1 


and 
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Because  of  the  relative  simplicity  of  A  1  , 
equation  (12)  in  terms  of  A-1  rather  than  A. 


it  is  simpler  to  reform 
Then 


(A-1)TS  a"1  -S  =  (A  1  )T  r$  A-1  . 

The  solution  of  this  set  of  9  equations  in  the  9  unknowns  ,  i,  j  =  1,2,3 

was  in  the  first  instance  attempted  by  hand.  A  range  of  relatively  simple 
subrelations  could  be  derived,  but  they  were  still  too  cumbersome  to  solve  in 
this  way.  The  relations  were 

Si  1  =  Sj  2  +  S2  1  , 

51  2  =  2  (Si  3  +  S22), 

52  1  =  2  (S3 1  +  S2  2  )  , 

803  S33  =  1+2  (04 -1)  (Si  3 +Ss  1  )  , 

S3 1  =  S3  2  =  -S23  , 

2  (1+04  )  (Si  3 +S3  1  )  +  2(201  +02+204)  S22  =  1, 

2c  (Si  3 -S3 1)  -  02+03  ,  and 

2c  S31  =  -04,  where 

C  =  02+03  -04  (02+303). 


These  subrelations  were  then  solved  using  routines  developed  in  APL  to 
manipulate  polynomials  of  several  variables (ref . 8) .  The  parameters  0i  , 

02,  03,  04  were  represented  initially  as  polynomials  in  r  and  s  =  1/ (1+r) , 
using  the  definitions  of  equations  (20) .  Subsequently  the  solutions  S^ 

could  be  represented  as  rational  polynomials  in  r.  The  solutions  which  were 
found  using  this  technique  give 


S 


4 (1-r)2  (l+2r-r2 ) ,  2(l-r)2  (2+5r-r2 ) ,  l+4-6r2  +  2r3 
2r (1-r)2  (1+r)  ,  -r(l+r)  (l-4r+r2),  2r2  (1+r) 

-2r2 (1+r)  ,  -2r2 (1+r)  ,  4r3 


/A, 


where  A  =  4(l-r)3 (l+4r+r2 ) ,  and  we  recall  that  =  1-r2. 


5.  RESPONSE  TO  STEP  FUNCTION 


5.1  General  step  function 

In  this  section  we  shall  consider  how  the  impulse  response  sequences 
derived  in  Section  3  may  be  used  to  find  the  filter  and  smoother  responses 
to  step  changes  in  the  input  signal.  We  are  particularly  interested  in  the 
three  separate  cases  of  step  changes  in  position,  velocity,  and  acceleration. 
However  they  may  be  treated  together  by  using  a  general  input  signal  of 


x 


k 


k  <  0, 
k  =  0, 
k  >  0, 


(22) 


where  x  and  Xo  are  constant  vectors  to  be  defined  later. 

The  restriction  for  k  >  0  is  not  severe  since  we  may  easily  recover  the 
complementary  set  of  step  functions  (with  x^  =  0,  k  <  0)  by  using  the 

linearity  of  the  filter  and  smoother. 

The  equation  (1)  of  Section  3.1  may  be  applied  to  the  signal  x^  to  give 
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and  hence 


k/k 


OO 

I 

N=k 


ANprx,  k>  0 

k-N 


Xk/k 


Xo/o’ 


k  >  0, 
k  <  0. 


(23) 


The  equations  (11)  for  the  smoother  may  similarly  be  applied  and  simpli¬ 
fied  for  k  >  0  to  show  that 


Xk/°° 


(4>-PS)Ak-1  x0/0 


P  T  x 


k/k’ 


k 


0. 


Consider  a  signal  such  that 


X 


k 


4>k  x  -  x.  . 

k 


(24) 


That  is,  Xk  is  the  step  function  complementary  to  xk>  for  which  Xk 
k  <  0.  Because  of  the  linearity  of  the  smoother  we  know  that 

xt/~  * -  xk/~- 

If  we  apply  the  impulse  function  (11)  to  Xk  we  have,  for  k  <  0 


=  0, 


and  hence 


_oo 

V»  =  Yj  PtAT)  N  1  Pr  Xk-N 

N=k 


p(at)1  kl  P"1 


Substituting  for  X^^  and  ^Qjoo  we  ^ave  finally 

Xk/°°  =  P(aT)I  ^  1  xo/o  +  C^-PCAT)lkl  P_1)x_,  k  <  0  (25) 

Equations  (23)  to  (25)  thus  completely  define  in  terms  of  analytically  known 
matrices  the  filter  and  smoother  response  to  the  general  step  function  signal 
defined  by  equation  (24) . 
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5.2  Numerical  solutions 


We  consider  the  input  signal  defined  by  equation  (22),  for  which  xq  =  x_. 


and  hence  xQ^o  =  x  . 

In  particular  we  are  interested  in  determining  the  ability  of  the  filter 
and  the  smoother  to  estimate  step  changes  in  position,  velocity,  and 
acceleration  respectively. 


Thus,  for  step  in  position,  xi- 

for  step  in  velocity,  x2_ 

and  for  a  step  in  acceleration,  x3- 


C1,0,0)T; 
(0,1, 0)T; 
(0,0, 1)T. 


The  filter  and  smoother  responses  comparable  to  each  of  these  steps  will 
simply  be  the  appropriate  diagonal  term  of  the  matrix  coefficients  of  x_ 
in  equations  (23) ,  (24)  and  (25) . 

Figures  1  and  2  give  the  results  of  numerical  calculation  of  these 
responses  for  two  separate  values  of  flj  .  Each  figure  shows  the  filtered 
position  component  when  there  is  an  input  step  in  position  (x_  =  Xi_  ) ;  the 
filtered  velocity  component  when  x_  =  X2-  ;  the  filtered  acceleration 
component  when  x_  =  x3-  ;  and  the  smoothed  position  component  when  x_  =  xi-  . 
The  other  smoothed  curves  (for  velocity  and  acceleration)  were  not  included, 
as  they  were  found  to  have  exactly  the  same  shape  as  the  smoothed  position 
component,  except  that  they  were  displaced  by  half  a  data  point  and  one  data 
point  respectively  to  the  left. 

It  is  quite  easy  to  show  analytically  that  an  appropriate  choice  of  xq 

as  %x_  or  0  will  simply  displace  the  smoothed  position  component  half  or  one 
data  point  respectively  to  the  left.  However  the  problem  of  showing 
analytically  that  the  respective  smoothed  position  and  velocity,  or 
position  and  acceleration  components  are  identical  is  not  readily  soluble 
(though  it  should  be  possible) .  (It  is  of  course  quite  straightforward  to 
prove  the  necessary  identities  for  k  =  0,1,-1). 

There  are  several  features  which  are  immediately  apparent  from  the 
figures  1  and  2 . 

(i)  The  fact  that  the  smoother  curves  are  identical  means  that  the 
smoother  is  able  to  accurately  estimate  changes  in  the 
derivatives  of  the  measured  components  of  the  state  vector.  At 
DRCS  this  has  been  utilized  extensively  to  allow  camera 
instrumentation  to  estimate  sharp  changes  in  acceleration.  It  is 
clear  that  the  filter  does  not  perform  nearly  so  well  in  this  area. 
That  is,  its  performance  deteriorates  rapidly  as  it  is  called  on 
to  estimate  higher  derivatives  of  the  measured  component. 

(ii)  The  filter  velocity  and  acceleration  curves  show  a  clear  lag 
before  there  is  a  response  to  the  step  change  in  velocity  and 
acceleration  respectively.  Since  we  may  show  from  equation  (23) 
that  the  position,  velocity,  and  acceleration  curves  at  k  =  1 
are  simply  (1-a.j),  (l-a2)  and  (l-a3),  then  it  is  evident  that 

is  a  reasonable  measure  of  bandwidth,  whereas  a2  and  a3  are  not, 
because  of  the  lag. 

(iii)  Overshoot  with  the  smoother  is  very  much  less  than  for  any  of  the 
filter  curves. 
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5.3  Smoother  response 

Rather  than  rely  on  numerical  results,  it  is  possible  to  derive  an  analy¬ 
tical  expression  which  gives  a  reasonable  measure  of  the  bandwidth  of  the 
smoother. 

From  equation  (24)  we  have 

xl/oo  -  x0/oo  -  ($-PS)  (I-A  1 )  xq/o. 

Hence  the  magnitudes  of  the  slopes  of  each  of  the  smoothed  curves  at  k  =  0 
are  simply  the  diagonal  elements  of 

W  =  -($-PS) (I-A_1 ) .  (26) 

We  choose  to  define  the  smoother  bandwidth,  in  terms  of  the  smoothed 

velocity  response  to  a  step  in  velocity,  since  this  curve  passes  through  the 
midpoint  at  k  =  0, 


(i.e.  (xq/oo)2  =  1/2(x_)2). 


All  the  matrices  on  the  right  hand  side  of  equation  (26)  are  known 
analytically,  and  hence  we  may  use  the  APL  polynomial  manipulation  routines 
to  show  that 

as  =  W22  =  (1-r2 )/  (l+4r+r2 ) ,  (27) 

where  r2  =  (1-ai).  (Note  that  all  diagonal  terms  of  W  will  be  independent 
of  7  and  h) . 

We  may  also  note  from  this  equation  that 

ai/as  =  l+4r+r2  >  1, 


that  is,  for  a  given  set  of  input  parameters  to  the  filter  and  the  smoother, 
the  smoother  will  exhibit  a  narrower  bandwidth  than  will  the  filter  with 
respect  to  position.  This  might  be  expected  from  intuition,  since  the 
smoother  is  influenced  by  twice  as  much  data  as  the  filter. 

The  relationship  between  a.\  and  is  plotted  in  figure  3. 


6.  CONCLUSION 

This  paper  has  presented  derivations  of  the  detailed  analytic  form  of  a  Kalman 
filter  and  smoother  when  position-measuring  instrumentation  is  used  to  estimate 
position,  velocity,  and  acceleration  changes  in  a  point  under  observation.  In 
the  course  of  an  analysis  of  this  system,  a  non-dimensional  parameter,  e,  has 
been  defined  (equation  (21))  which  is  shown  to  completely  determine  the  filtering 
and  smoothing  characteristics  of  the  system. 

Through  analysis  of  the  response  of  the  system  to  various  input  step  functions, 
a  relationship  is  derived  connecting  the  bandwidth  of  the  smoother  to  the  band¬ 
width  of  the  filter  with  respect  to  position.  This  relationship  shows  that  for 
given  input  parameters,  the  filter  will  have  greater  bandwidth  (with  respect  to 
position)  than  will  the  smoother. 
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The  analysis  also  shows  the  clear  superiority  of  the  smoother  over  the  filter 
when  changes  in  velocity  and  acceleration  are  being  estimated  with  position¬ 
measuring  instrumentation. 

In  two  specific  respects  the  analysis  is  incomplete.  Firstly,  it  has  not 
been  possible  to  derive  a  simple  analytic  representation  of  the  bandwidth  of 
the  filter  with  respect  to  velocity  and  acceleration,  though  it  is  clear  from 
figures  1  and  2  that  they  would  differ  markedly  from  that  for  position. 

Secondly,  it  has  not  been  possible  to  show  analytically  that  there  is  an 
identically  shaped  smoother  output  of  position,  velocity,  and  acceleration 
when  there  is  a  step  in  the  input  signal  of  the  same  component. 
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Figure  2.  Response  to  a  step  in  the  input  signal  of  the  corresponding  component 
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